import rospy
import sys
import moveit_commander
from geometry_msgs.msg import PoseStamped, Pose

from probot_anno_demo.msg import RobotPost
